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Abstract —  This  work  studies  optimal  sensor  placement  and 
motion  coordination  strategies  for  mobile  sensor  networks. 
For  a  target  tracking  application  with  range  sensors,  we 
investigate  the  determinant  of  the  Cramer-Rao  Lower  Bound 
and  compute  it  in  the  2D  and  3D  cases.  We  characterize  the 
global  minima  of  the  2D  case.  We  propose  and  characterize 
motion  coordination  algorithms  that  steer  the  mobile  sensor 
network  to  an  optimal  deployment  and  that  are  amenable 
to  a  decentralized  implementation.  Finally,  our  numerical 
simulations  illustrate  how  the  proposed  motion  coordination 
algorithms  lead  to  the  improved  performance  of  an  extended 
Kalman  filter  in  a  target  tracking  scenario. 

Index  Terms — motion  coordination,  optimal  sensor  place¬ 
ment,  Cramer-Rao  Lower  Bound,  Kalman  filtering. 

I.  Introduction 

New  advancements  in  the  fields  of  microelectronics 
and  miniaturization  have  generated  a  tremendous  surge 
of  activity  in  the  design  and  development  of  sensor  net¬ 
works.  The  envisioned  groups  of  agents  are  endowed  with 
communication,  sensing  and  computation  capabilities,  and 
promise  great  efficiency  in  the  realization  of  multiple  tasks 
such  as  environmental  monitoring,  exploratory  missions 
and  search  and  rescue  operations.  However,  several  fun¬ 
damental  problems  need  to  be  solved  in  order  to  make  this 
future  technology  possible. 

One  main  difficulty  is  the  requirement  for  decentralized 
architectures  in  which  each  agent  takes  autonomous  deci¬ 
sions  based  on  information  shared  with  only  a  few  local 
neighbors.  Ongoing  research  work  focuses  on  decentralized 
filters  and  data-fusing  methods  for  estimation,  and  on 
the  motion  algorithms  that  guarantee  the  desired  global 
behavior  of  the  network.  Ideally,  both  the  motion  control 
algorithms  and  estimation  processes  should  be  optimally 
integrated  to  make  the  most  of  the  network  performance. 

In  this  paper  we  investigate  the  design  of  distributed  mo¬ 
tion  coordination  algorithms  that  increase  the  information 
gathered  by  a  network  in  static  and  dynamic  target-tracking 
scenarios.  In  order  to  do  this,  we  define  an  aggregate  cost 
function  that  encodes  a  “sensitivity  performance  measure” 
and  design  motion  coordination  algorithms  maximizing  it. 

This  idea  has  been  widely  used  in  papers  on  optimum 
experimental  design  for  dynamical  systems  with  appli¬ 
cations  to  measurement  problems.  An  incomplete  list  of 
references  is  [1],  [2],  [3],  [4],  [5],  [6].  For  example  [3], 


[4],  [5]  deal  with  problems  on  target  tracking  and  param¬ 
eter  identification  of  distributed  parameter  systems.  The 
motion  control  algorithms  proposed  in  these  papers  either 
are  computed  via  some  off-line  numerical  method  or  are 
gradient  algorithms.  Often  these  algorithms  are  designed  to 
maximize  an  appropriate  scalar  cost  function  and  to  choose 
the  best  sensor  locations  from  a  grid  of  finite  candidates. 
Unfortunately,  these  schemes  turn  out  to  be  not  distributed 
since  in  order  to  define  the  control  law  for  each  agent,  it  is 
necessary  to  know  all  other  agents’  positions  at  each  step. 

A  second  set  of  relevant  references  are  those  on  dis¬ 
tributed  motion  coordination.  To  define  our  proposed  con¬ 
trol  algorithm  we  build  on  recent  results  on  the  analysis  of 
cyclic  pursuit  [7],  flocking  [8],  and  consensus  [9]. 

The  contributions  of  this  paper  are  the  following.  Un¬ 
der  the  assumption  of  Gaussian  noise  measurements  with 
diagonal  correlation,  we  obtain  in  Section  II  closed-form 
expressions  for  the  determinant  of  the  Fisher  Information 
Matrix  for  “range-measurement”  models  in  non-random 
static  scenarios,  for  2  and  3  dimensional  state  spaces.  We 
characterize  the  critical  points  of  these  functions  and  obtain 
sets  of  positions  that  globally  maximize  the  value  of  the 
2D  version.  If  the  sensors  measure  distances  to  the  target, 
then  a  optimal  configuration  is  one  in  which  the  sensors 
are  uniformly  placed  in  circular  fashion  the  target. 

This  optimal  configuration  serves  as  a  starting  point  in 
Section  III.  Here  we  consider  a  target  tracking  scenario 
described  by  the  following  assumptions:  the  sensors  move 
along  the  boundary  of  a  convex  set  containing  the  target. 
We  define  discrete-time  control  laws  that,  relying  only  on 
local  information,  achieve  the  uniform  configuration  around 
the  target  (estimate)  exponentially  fast.  In  essence,  our 
laws  are  very  intuitive  and  simple-to-implement  interaction 
behaviors  between  the  sensors. 

Finally,  in  Section  IV,  we  validate  our  control  laws  in 
a  particular  dynamic  target-tracking  scenario.  Although  we 
studied  the  global  optimum  configurations  for  a  nonrandom 
static  parameter  estimation  scenario  we  adopt  the  results  in 
a  dynamic  random  scenario.  Our  simulations  illustrate  the 
following  reasonable  conjecture:  optimizing  the  sensitivity 
function  for  the  static  non-random  case  improves  the  per¬ 
formance  of  a  filter  (in  our  case  an  EKF)  for  the  dynamic 
random  scenario. 

As  a  final  remark,  we  point  out  that  we  do  not  deal 
here  with  the  problem  of  decentralized  filters  and  data- 
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fusion,  taking  into  account  communication  constraints.  It 
is  assumed  that  the  process  of  estimation  is  performed  by 
a  central  site  or  by  a  distributed  process  that  we  do  not 
implement.  For  works  that  deal  with  multisensor  fusion 
possibly  under  communication  constraints  we  refer  to  [10], 
[11],  [12],  [13]  and  references  therein. 


Let  q=  {q^ , . . . ,  and  define  the  shorthands 

d 

dehj{qo,pi,. . .  ,pn)  =  jreHh-PjW) 

aq  q=qo 

for  j  G  {1, . . . ,  n}  and  £  G  {1, . . . ,  d}.  Then  G  :  x 

^  can  be  computed  to  be 


II.  Optimal  placement  of  sensors 

Here  we  present  the  assumptions  over  our  sensor  net¬ 
work  and  target  models  in  (1)  non-random  static  parameter 
estimation  scenarios  and  (2)  random  dynamic  parameter  es¬ 
timation  scenarios.  We  obtain  the  corresponding  Fisher  In¬ 
formation  Matrices  (FIMs)  and  Cramer-Rao  Lower  Bounds 
(CRLBs).  We  analyze  the  global  minima  of  the  determinant 
of  the  CRLB  as  a  means  to  guarantee  increased  sensitivity 
with  respect  to  the  sensors’  measurements.  See  [14]  for  a 
comprehensive  treatment  on  estimation  and  tracking. 

A.  The  non-random  parameter  estimation  scenario 

The  localization  of  static  targets  can  be  solved  as  a 
non-random  parameter  estimation  problem  as  follows.  Let 
Pj  G  R"^,  J  G  {1, . . . ,  n},  denote  the  position  of  n  sensors 
moving  in  a  convex  region  Q  C  and  let  qg  G  Q  be  the 
unknown  target  position  to  be  estimated  by  means  of  the 
measurement  model; 

=  h(h-Pjll)  +  ,  q&Q,  (1) 

for  j  G  Here,  h  :  [0, -boo)  =  R+  ^  R  is 

defined  according  to  the  particular  sensors’  specifications 
and  Wj  represents  a  white  noise,  j  G  {1, . . . ,  n}. 

In  other  words,  the  stacked  vector  of  measurements  at  a 
certain  instant  is  a  random  vector  normally  distributed  as 


■Zl 

/ 

1 

1 

z  = 

V 

1 

>45 

1 

where  R  =  RA  >  0  is  the  n  x  n  covariance  ma¬ 
trix.  From  now  on,  we  will  use  the  shorthand  notation 
Z  =  {zi,...,ZnA,  and  H  will  denote  the  function 
H{q,Pi,...,Pn)  =  {h{\\q-pi\\),...,h{\\q-pn\\)A. 

The  Fisher  Information  Matrix  (FIM)  for  non-random 
parameters,  denoted  by  Jnr,  is  defined  as  the  expected 
value  with  respect  to  the  probability  distribution  p{Z\q)\ 

Jnr  =  i?  [(V,  log  A)  •  (V,  log  A)^]  , 

where  qg  is  the  true  value  of  the  target  location  or  an  esti¬ 
mate  of  it,  Vq  =  [^r,  ■  •  ■  5  ^  ^nd  A  is  a  shorthand  for 

K(q,pi, . . .  ,pn)  =  p{zi, . . . ,  Zn\q),  the  likelihood  function. 


Gj£{qO,Pl,  ■  ■  ■,Pn)  =  dihj{qg,Pi,  .  .  .  ,Pn)  , 

for  j  G  {1, . . . ,  n}  and  £  G  {1, . . . ,  d}.  In  the  particular 
case  that  R  =  the  FIM  Jnr  can  be  expressed  as: 


Jnr(<70,P1,  •  ■  •  ,Pn)  —  —^G^G{qg,Pi,  .  .  .  ,Pn) 


n 


E 


(dih.A 


{ddhj){dihY 


{dihj){ddhj) 

{ddhjY 


(2) 


B.  The  dynamic  random  parameter  estimation  scenario 

Dynamic  targets  can  be  thought  of  random  parameters 
evolving  under  a  stochastic  difference  equation.  Here  we 
assume  that  the  target  position  q{k)  at  time  k  G  NU{0} 
satisfies: 

q(k)  =  Fk{q{k  -  1))  -f  v{k) ,  fc  >  1,  g(0)  =  qg  , 

for  some  functions  :  R*^  ^  R*^  and  v{k)  i.i.d  as  v{k)  ~ 
Af (0,  N{k)),  where  N{k)  =  N{kA  >  0,  V/c  >  0,  and 
E[v{ki)v{k2A]  =  Si2N{ki),  Vfci,  k2  >  0.  Similarly  as 
before,  we  model  our  sensor  network  as 

Z{k)  =  Hk{q{k),pi{k), . . .  ,p„(fc))  +  w{k),  k>0, 

with  Hk{q{k),pi{k), . . .  ,Pn{k))  =  {hk{\\q{k)-pi{k)\\, . . . , 
hk{\\q{k)  —  Pn{k)\\)),  for  some  functions  hk  :  R+  — >  R, 
and  Z{k)={zi{k), . . . ,  Zn{k)),  fc  >  0.  We  will  assume  that 
w{k)  ~  N{b,R{k)),  where  R{k)  =  R{kA  >  0,  k  >  0, 
and  that  E[w{ki)wlk2  A]  =  6i2R{ki),  Vfci,  k2  >  0. 

An  estimation  method  that  is  widely  employed  for  the 
detection  of  targets  is  that  of  the  Extended  Kalman  Filter 
(EKF)  [14].  The  assumptions  for  the  filter  require  q{k)  and 
Zik)  to  be  jointly  Gaussian  distributed  with  covariance 
P{k)  =  P{kA ,  and  E[q{ki)w{k2)]  =  0,  VA:i,fc2  >  0. 
The  EKE  provides  a  state  estimate  q{k)  together  with  an 
estimate  for  the  covariance  of  the  error  Pe{k): 

PYk)  =  Pp{k)-W{k)S{k)W{kA ,  k>l. 

Here,  Pp{k)  is  the  predicted  covariance  of  the  er¬ 
ror,  W{k)  =  Pp{k){Vqtk)FkAS~^{k)  and  S{k)  = 
(y q(k)Fk)Pp{k){V g(k)Fkr  +  Fik)-  Let  qp{k)  be  the 
predicted  value  of  q{k).  Some  standard  computations  [14], 
[11],  allow  us  to  say  that 


A{q,pi,...,Pn)  = 

A  few  computations  show  Jnr  =  {V qHA^R~^ {V qH)qQ. 
The  matrix  G  =  yqH)qq  is  usually  called  the  Sensitivity 
Matrix  associated  with  our  set  of  measurements. 


PfAk)  =  P-l(fc)  +  yqHk\q^^k)AR-Ak)VqHk\q^(k) 

or,  denoting  {SJ qHk\q^(k)A R~^{k)SJ qHk\q^(k)  =  JnAk), 

PfAk)  =  P-l(fc)  +  JNR(fc)  ,  fc  >  0  .  (3) 

That  is,  the  EIM  for  the  non-random  case  appears  as  a 
summand  in  the  expression  for  the  inverse  of  the  predicted 


covariance  matrix  of  the  EKF.  Similarly,  when  the  mea¬ 
surement  model  is  linear,  an  analogous  set  of  computations 
allows  us  to  derive  a  relationship  between  the  FIM  for 
dynamic  random  parameters,  denoted  by  Jdr  at  step  fc  >  0, 
and  JNR(fc)  given  by 

Jonik)  =  P~q  +  JNR{k) ,  (4) 

where  Pgg  =  E[{q{k)  -  qk){q{k)  -  qkV]. 


C.  Cost  functions  for  optimal  sensing 

As  is  well  known,  the  FIM  encodes  the  amount  of  infor¬ 
mation  that  a  set  of  measurements  produces  in  estimating 
a  set  of  parameters.  Under  the  assumptions  we  have  made 
in  former  sections  FIM  =  CRFB“^;  i.e.,  the  FIM  is  the 
inverse  of  the  Cramer  Rao  Fower  Bound,  which  is  known 
to  lower  bound  the  inverse  of  the  covariance  of  the  error' 

J-'  =  CRFB  <  E[iq  -  qo)iq  -  qof]. 


Because  of  this,  one  expects  that  “minimizing  the  CRFB” 
results  in  a  decrease  of  uncertainty. 

This  line  of  reasoning  has  been  a  main  theme  in  several 
papers  dealing  with  optimum  experimental  design  and 
active  sensing  e.g.,  see  [3],  [4],  [15],  [1].  Starting  from 
the  FIM  (resp.  the  CRFB)  of  the  estimation  approach,  an 
evaluation  function  is  defined  (usually  the  determinant  or 
the  trace  of  the  FIM/CRFB)  whose  maximization  (resp.  its 
minimization)  is  to  be  achieved.^ 

As  before,  let  qg  €  be  the  true  value  of  the  target 
location  or  an  estimate  of  it.  Under  the  assumptions  of 
Subsection  II-A  and  Il-B,  we  define  our  cost  function  Cg^  : 
^  by 

Cgg{pi,...,Pn)  =  det  JNR(go,Pi,  ■  •  •  ,P«),  (5) 


with  Jnr  given  in  (2).  Because  of  the  relationships  (3) 
and  (4),  we  are  guaranteed  that,  if  we  optimize  Cgg  with 
respect  to  the  positions  of  the  sensors,  then  we  will  get  in¬ 
creased  performance  in  both  the  non-random  and  dynamic 
random  parameter  estimation  scenarios  with  FKFs. 

In  what  follows  we  derive  the  expression  for  the  cost 
function  Cg^  for  d  =  2  and  d  =  3  and  analyze  its  critical 
points  and  global  maxima.  To  do  this,  we  shall  assume  that 
our  measurement  model  is 

=  +  (6) 

I  0,  otherwise 


for  7  G  {  — 1,-|-1},  /3  €  Z,  and  constants  Ri  >  Rq  >  0, 
C2,  Cl  G  K.+.  Range  sensors  such  as  sonars  can  be  modeled 
by  /3  =  1,  7  =  1  and  ci  =  C2  =  0. 

Proposition  2.1:  For  q^  G  let  £gg  :  ^  IR+ 

be  defined  as  in  (5)  and  h  be  defined  as  in  equation  (6). 
Consider  the  set  S  =  {pi  G  {pi,  ...,pn}\  h{\\pi  -  go||)  7^ 
0}.  The  following  statements  hold  true. 

(i)  For  d=2, 

k^qoiPi,---,Pn)  =  ^  ||v,f  ||vjf  sin^ay 


^For  efficient  estimators,  this  inequality  becomes  an  equality. 

^For  det  J,  this  technique  is  known  as  the  D-optimum  design  [15]. 


where  aij  =  Z(vi,Vj),  and  =  {dihi,d2hi,0), 
liv*|p  =  (3‘^{\\p^  -  goll  -  i,j  G  S. 


(ii)  For  d  =  3, 


k^qo  (Pii  •  ■  •  — 

^  Y  llv*f  I|v^-f  llvfcf  sin^tty  cos^Aj,fc 
iJ,k£S 


where  aij  =  =  Z(vi  x  Vj,Vk),  and 

Vi  =  {dihi,d2hi,d3,hi),  with  |lvi|p  =  - 

<7o||  -  for  i,j,k  G  S. 

Proof:  The  proof  can  be  found  in  Appendix  A.  ■ 
Fet  us  now  introduce  some  useful  notation.  Fet  T  be  the 
circle  in  the  plane  and  let  £t  :  T"  — ^  K+  be  defined  by 


£t(^1,  •  ■  •  ,  <5n) 


Y  sin^(^i 

i,jes 


Sq), 


where  R  =  maXrg[i{j,^_R,] (r  —  >  0.  Now,  let 

d  =  2  and  assume  qo  pi,  for  i  G  n}.  Consider 

a  polar  change  of  coordinates  centered  at  go  G 
identify  pi  G  with  {r]i,ri)  for  some  angle  pi  Gf  and 
Ti  G  R.+,  i  G  n}.  With  these  notations,  we  have  that 

Cgg{pi,...,Pn)  <  •  ,?7n)  and  (pi,...,p„)  is  a 

global  maximum  of  Cg^  if  and  only  if  (rj  — =  R, 
i  G  S  and  (pi, . . . ,  pn)  is  a  global  maximum  of  Cf.  With 
these  assumptions  {d  =  2)  we  analyze  the  maxima  of  Cf. 

Proposition  2.2:  The  following  statements  hold  true. 

(i)  The  point  {pi,. . .  ,pn)  G  T"  is  a  critical  point  for 
C^  if  and  only  if  either 

^cos2?7i  =  0,  'Y.  sd\2pi  =  0, 

i^S  i^S 

or  any  two  vectors  in  {(cos 2?7i, sin 2?7i)}jg5,  are 
aligned. 

(ii)  maxFqj,  =  maxCT  =  ^4^  ns,  where  ns  =  |5|. 

(iii)  Define  pi^  =  (s  —  l)7r/n,  where  ig  G  S  for  s  G 
(1, . .  .,ns},  ns  =  |5|.  Then,  {{pi  +  kiir,  ...,pn  + 
kn'^)  I  fci,  •  ■  • ,  G  Z}  are  global  maxima  for  Cf. 

Proof:  We  refer  to  Appendix  B  for  a  proof.  ■ 

Remark  2.3:  Due  to  the  periodicity  of  C^  for  T  =  tt, 
there  also  are  global  maximum  with  multiple  sensors  at  the 
same  position.  This  could  be  a  consequence  of  our  assump¬ 
tions  that  the  measurement  noises  Wj  are  uncorrelated.  It 
is  a  conjecture  that,  if  the  Wj  depended  on  the  sensors 
locations,  then  coincident  locations  could  not  be  part  of 
the  set  of  maximum  points.  • 


Ill.  Decentralized  motion  coordination  eor  the 

NON-RANDOM  PARAMETER  SCENARIO 

In  this  section  we  present  a  family  of  decentralized 
control  laws  that  steers  the  sensors  locations  to  a  set  of 
points  of  maximum  for  the  cost  functions  discussed  in  the 
previous  section.  Our  analysis  methods  are  related  to  the 
approaches  in  [7],  [8],  [9].  We  make  the  following  assump¬ 
tions  on  the  agents’  motion,  sensing,  and  communication: 
(i)  a  static  target  go  belongs  to  the  interior  of  a  compact 
convex  set  Q  with  boundary  OQ; 


(ii)  the  measurement  model  is  the  one  described  in 

equation  (1)  with  h{r)  =  r,  i.e.,  equation  (6)  with 
7  =  1,  /3  =  1,  Cl  =  C2  =  0,  i?o  =  0^  =  +oo; 

(iii)  each  of  the  sensors  {pi, . . .  ,p„}  moves  in  discrete 
time  in  an  unbounded  fashion  along  dQ; 

(iv)  each  of  the  sensors  {pi, . . .  ,p„}  detects  its  immedi¬ 
ate  clockwise  and  counterclockwise  neighbors  in  dQ 
and  knows  its  relative  position  along  dQ. 


P2  Pi 


Pi  P5 


In  what  follows,  we  let  go  denote  the  current  estimate  of 
the  target  location  and  ipqoip)  be  the  angular  component 
of  the  polar  coordinates  centered  at  qq.  In  summary,  we 
can  identify  pi  e  dQ  C  with  pi  =  <Pqo{pi)  G  T,  for 
iG 

B.  Two  basic  behaviors  for  uniform  coverage  of  the  circle 

As  discussed,  the  location  of  the  sensors  is  described 
by  the  vector  (pi, . . . ,  ?7„)  of  elements  of  T.  We  assume 
that  angles  are  measured  counterclockwise  and  that  the 
sensors  are  placed  in  counterclockwise  order  (we  adopt  the 
convention  that  77„+i  =  pi  and  that  po  =  pn). 

The  motion  of  the  sensors  is  described  by  a  discrete-time 
control  system: 

Pi{k  +  1)  =  Piik)  +  Ui,  iG  n}. 


Fig.  1.  Assumptions  (i)  and  (iii):  the  sensors  move  along  the  boundary 
of  Q  and  the  target  moves  inside  Q. 


For  this  non-random  parameter  estimation  scenario  with 
limited  information,  the  motion  coordination  objective  is 
to  steer  {pi, . . .  ,p„}  to  the  equally-spaced  angle  positions 
around  the  target  qq  exponentially  fast. 

Remark  3.1:  •  Assumptions  (ii),  (iii)  and  (iv)  could 

be  modified  to  include  an  upper  bound  on  the  motion 
and  detection  range  of  the  sensors;  we  leave  these 
important  extensions  to  future  works  (in  the  interest 
of  brevity). 

>  Assumption  (iv)  means  that  an  implementable  control 
law  for  an  agent  can  only  depend  on  the  agent’s 
position  relative  to  its  neighbors  (in  the  natural  ring 
topology  along  dQ).  We  will  call  such  a  control  law 
spatially  distributed  along  dQ. 

>  We  will  allow  the  control  law  to  depend  on  the  current 

estimate  of  the  target  location.  This  strategy  is  said  to 
be  of  the  “certainty  equivalence”  type.  • 


A.  From  the  boundary  of  Q  to  a  circle  and  back 

Because  we  assume  that  the  n  sensors  can  be  placed  only 
along  the  boundary  of  the  convex  set  Q,  we  can  simplify 
the  design  of  motion  control  strategies  as  follows.  Instead 
of  working  with  the  positions  pi, . . .  ,p„  in  dQ,  we  will 
work  with  their  polar  coordinates  centered  at  qq,  and  we 
will  define  our  motion  control  algorithms  on  the  circle. 

Let  us  be  more  formal  on  this  matter.  Let  dQ  be 
implicitly  defined  by  the  continuous  equation  x  G  dQ  if 
and  only  if  g{x)  =  0.  Given  a  point  q  in  the  interior  of  a 
compact  convex  set  Q,  define  the  map  tpq  :  dQ  ^  T  by 

One  can  show  that  the  map  ipq  is  continuous  with  contin¬ 
uous  inverse  tp~^  :  T  ^  dQ  given  by 

=q  +  \v, 

where  A  G  M+  the  unique  solution  to  g{q  +  Xp)  =  0. 


Here  Ui  is  the  scalar  control  magnitude  of  the  ith  sensor. 
The  control  can  depend  only  the  measurement  and  commu¬ 
nication  available  to  the  sensor,  i.e.,  Ui  is  a  function  only 
of  the  relative  angular  distances  in  the  counterclockwise 
direction  dcounter-ciock.i  =  Ri+i  -  Pi  >  0  and  clockwise 
direction  dciock.t  =  Vi  —  Vi-i  >  0-  We  also  assume 
that  each  sensor  obeys  the  same  motion  control  law  u  : 
[0,  27r]  X  [0,  27r]  ^  R,  so  that  the  closed-loop  system  will 
be 


Pi{k  -f  1)  —  (dcounterclockji  (^)  5  t^clock, i{k)) , 

t:^counterclock,i  (^)  —  Vi{^)^ 

dc\ock,iik)  =  Pi{k)  -  pi-i{k). 


In  order  to  achieve  uniform  distribution  of  the  sensors 
on  the  circle,  two  simple  behaviors  arise  fairly  naturally, 
see  Figure  2.  First,  we  consider  the  Go  TOWARDS  THE 
MIDPOINT  behavior  Umidpoint  :  [0,  27r]  x  [0,  27r]  ^  R  given 
by: 


ttmidpoint(t^counterclocki  I^clock)  —  2  (^counterclock  t^clock)  • 


The  interpretation  is  clear:  each  sensor  moves  towards  the 
midpoint  of  the  angular  segment  between  the  preceding 
and  following  sensor.  In  the  original  coordinate  system, 
each  sensor  moves  along  dQ  towards  the  bisector  of  the 
triangle  with  vertex  go  vertices  given  by  the  preceding 
and  following  sensor. 


Fig.  2.  The  Go  TOWARDS  THE  MIDPOINT  U1/2  and  Go  TOWARDS  THE 
MIDPOINT  OF  VORONOI  SEGMENT  U1/4  behaviors. 


A  second  intuitive  rule  is  the  Go  TOWARDS  THE  MID¬ 
POINT  OF  VORONOI  SEGMENT  behavior  ■Umidpoint  Voronoi  : 
[0,  27r]  X  [0,  27r]  ^  K.  given  by: 


Umidpoint  Voronoi  (t:^counterc lock  1  t^clock)  —  ^  (ti^counterclock  ti^clock)  • 


The  interpretation  is  the  following:  the  Voronoi  segment  of 
the  ith  sensor  at  position  rji  is  the  angular  segment  from 
{r]i-i  -\-  r]i) 1 2  to  (rji  -f  ?7i+i)/2,  and  the  control  law  GO 
TOWARDS  THE  MIDPOINT  OF  VORONOI  SEGMENT  Steers 
rji  towards  the  midpoint  of  this  segment. 

These  two  rules  are  particular  instances  of  the  following 
family  of  linear  algorithms  parametrized  by  /C  G  M: 


tt/c(l^counterclock;  ti^clock)  —  ^ (l^counterclock  l^clock)- 


Clearly,  Umidpoint  and  t/midpoint  Voronoi  ecjual  to  for 
/C  =  1/2  and  /C  =  1/4,  respectively.  Because  uic{d,  d)  =  0 
for  all  d  €  IR.+,  the  equally-spaced  angle  position  (where 
the  sensors  are  uniformly  distributed  around  the  target)  is 
an  equilibrium  point^  for  the  ujc-closed-loop  system. 


C.  Convergence  analysis 

To  perform  a  convergence  analysis,  it  is  convenient  to 
define  the  relative  angular  distances  di  =  rji+i  —  rji,  for  i  G 
{ 1, . . . ,  n}  (and  adopt  the  usual  convention  that  dn+i  =  di 
and  that  dg  =  dn)-  So  long  as  the  counterclockwise  order  of 
the  sensors  is  not  violated,  we  have  (di, . . .  ,dn)  G  S2tt  = 
{x  G  I  X,  >  0,  Sfci  ~  change  of  coordi¬ 

nates  from  (rji, . . .  ,r]n)  to  {di, ...  ,dn)  and  the  control  law 
ujc  jointly  lead  to  the  closed-loop  system 

di{k  -f  1)  =  ICdi+i{k)  -f  (1  —  2IC)di{k)  +  ICdi-i{k). 


This  is  a  linear  time-invariant  dynamical  system  with  state 
d  =  {di, . . . ,  dn),  transition  matrix  Ajc  given  by 

'1  -  2/C  /C  •  •  •  /C  ■ 

/C  1-2/C  ••  •  0 

•  .  .  •  5 

_  /C  0  /C  1  -  2/C_ 

and  governing  equation 


d{k  +  1)  =  Ajcd{k) ,  for/cGNUjO}.  (7) 


Theorem  3.2:  The  control  law  Ufc  is  spatially  distributed 
along  dQ,  and,  for  JC  g]0,  l/2[,  the  solutions  to  the 
corresponding  closed-loop  system  (7)  preserve  the  counter¬ 
clockwise  order  of  the  sensors  and  converge  exponentially 
fast  to  (27r/n, . . . ,  27r/n). 

Proof:  Recall  the  notion  and  properties  of  circulant 
matrices  from  Appendix  C.  Note  that  A^c  is  circulant  with 
representer (s)  =  (1  — 2/C)-|-/Cs-|-/Cs"“^.  Theorem  1.1 
implies  that  the  eigenvalues  of  Ajc  are 

M  =  PAfc  (^exp  - )  j  =  1  —  2/C  +  2/C  cos  ( - j, 


^The  more  general  linear  feedback  'u(i/counterciock>  ^ciock)  = 
^i<^counterciock  +  ^<^ciock  does  not  have  the  desired  equilibrium  set  unless 
a  +  6  =  0.  The  case  of  a  +  6  7^  0  is  studied  in  the  context  of  cyclic 
pursuit,  see  [7]  and  references  therein. 


for  £  G  n}.  It  is  easy  to  see  that  =  1  and  that 

the  corresponding  eigenvector  is  1^  =  If/C  >  0 

and  £  G  {1, . . . ,  n  —  1},  then 

27r-£ 

—  1  <  cos  ( - )  <  1  1  —  4/C  <  <  1. 

'  n  ' 

Therefore,  if  /C  g]0,1/2[,  then  the  eigenvalues 
Ai,...,A„_i  belong  to  the  open  interval  ]  —  1,1[. 
Additionally,  if  /C  g]0,1/2[,  then  Ax,  is  a  doubly- 
stochastic  matrix,  so  that  S2tt  is  invariant  for  Ax. 

Let  {ei,  •  •  •  ,  e„_i,  1}  be  a  basis  of  orthogonal  eigenvec¬ 
tors  for  Ax  corresponding  to  the  eigenvalues  {Ai, . . . ,  A„}, 
respectively.  Any  initial  condition  (/(O)  satisfies 

n—1 

d{0)  =  peee  +  Pni  ■ 
e=i 

Since  '^*(0)  =  ^tt,  we  have  that 

2'jr 

27r  =  l^<i(0)  =  =  Pnn  Pn  =  -  . 

n 

On  the  other  hand, 

n—1 

d{k)  =  Axdfk  -  1)  =  X!  ■ 

e=i 

If  /C  g]0,  1/2[,  then  each  |A^|  <  1,  for  f  G  {1, . . . ,  n  —  1} 
and,  therefore,  each  trajectory  k  d{k)  converges  to  /9„1, 
the  equal-angle  configuration,  exponentially  fast.  ■ 

Remark  3.3:  (i)  The  properties  of  ux  in  Theorem  3.2 

are  independent  of  the  number  n  of  sensors. 

(ii)  If  /C  <  0  or  /C  >  1/2,  then  there  exist  initial 
conditions  from  which  the  counterclockwise  order  of 
the  sensors  is  not  preserved  in  the  closed  loop. 

(iii)  Consider  the  /C  =  1/2  case,  corresponding  to  the 
Go  TOWARDS  THE  MIDPOINT  behavior.  Although 
Go  TOWARDS  THE  MIDPOINT  is  a  very  natural 
algorithm  to  consider,  it  does  not  ensure  conver¬ 
gence  to  the  desired  configuration  whenever  n  is 
even.  In  fact,  if  n  =  2L  with  L  G  Z,  then 
1  and  e])  =  (— 1, 1,  — 1, . . . ,  — 1, 1)  are  eigenvec¬ 
tors  with  eigenvalues  1  and  —1  respectively.  Given 
{ei . . . ,  e„_i,  1}  an  orthogonal  basis  of  eigenvectors 
for  Ai/2  and  d{0)  =  YliZi  Pi^i  +  Pn'^,  one  can 
show  that  the  system  will  exponentially  converge  to 
a  steady  oscillation  between  Ui  =  /9„1  -f  plg.l  and 

U2  =  Pnl  -  PLfiL.  • 

IV.  Target  tracking  simulations  with  Kalman 

FILTERING  AND  MOTION  COORDINATION  ALGORITHMS 

Here  we  combine  the  developments  of  former  sections  to 
define  the  Active  Target  Tracking  algorithm  for  collective 
improved  sensing  performance.  We  numerically  simulate 
the  algorithm  to  validate  our  approach.  It  is  assumed  that 
the  estimation  step  is  carried  out  after  a  round  of  commu¬ 
nication  has  taken  place  to  propagate  all  the  measurements 
taken  among  the  agents^.  The  algorithm  is  summarized  in 
the  following  table. 

'*This  would  be  equivalent  as  having  a  fusion  center  that  centralizes  the 
estimation  process 


Name:  Active  Target  Tracking  Algorithm 

Goal:  Decentralized  motion  coordination  of  sen¬ 

sors  and  joint  localization  of  target 
Data:  (i)  Constant  JC  g]0,  1/2[. 

(ii)  Equation  for  the  boundary  of  the  con¬ 
tainment  region,  5(g)  =  0. 

(iii)  Initial  guess  for  the  target  initial  posi- 
tion  go(0).  

At  time  k,  local  agent  i  G  {1, . . . ,  n}  performs; 

1:  Receive  estimate  qo{k)  from  fusion  center. 

2:  Detect  counterclockwise  and  clockwise  neighbors 
along  dQ,  compute  angular  distances  in  polar  coor¬ 
dinates  about  qo{k). 

3:  Compute  control  next  desired  position  r7i(fc-|-l)  G 
T,  and  corresponding  point  pi{k  +  1)  G  dQ. 

4:  Move  to  new  position  pi{k  +  1)  along  dQ. 

5:  Take  new  measurement  of  target  Zi{k  +  1),  and  send 
it  to  fusion  center,  that  will  update  target  estimate 
according  to  EKE. 

In  what  follows  we  present  our  numerical  results,  we 
compare  the  estimation  errors  of  the  trajectory  of  a  dynamic 
target  obtained  from  a  set  of  four  stationary  and  moving 
sensors.  Eor  the  purpose  of  the  simulation,  Q  will  be  a  ball 
centered  at  the  origin  with  radius  1.5m,  and  the  trajectory 
or  the  target  will  be  the  eight-shaped  curve; 


Qoik) 

sinjw/c) 

Qoik) 

sin(wfc)  cos{ujk) 

Here  (gg,  gg)  are  measured  in  meters  and  w  =  .1  rad/sec. 

In  all  the  subsequent  figures,  the  plots  compares  the 
evolution  of  the  absolute  error  trajectories  along  time, 
E{k)  =  ||go(^)  —  9o(^)||  for  stationary  sensors  (solid  blue 
line)  and  moving  sensors  (dashed  red  line),  for  fc  >  0. 

The  first  set  of  simulations,  Eigure  3,  reproduce  the 
results  obtained  for  four  sensors  initially  positioned  at 
2.1818,  2.4500,  3.7160,  and  4.5167  radians.  As  can  be 
seen,  the  moving  sensors  perform  better  on  average  as 
the  variance  increases.  In  the  second  set  of  simulations. 


Fig.  4.  Evolution  of  absolute  error  trajectories  with  variances  of  measured 
noise  5  x  10“^  (left)  and  10“^  (right). 


to  order  10“^.  One  has  to  increase  the  order  of  noise 
to  10“^  to  observe  a  clear  difference  in  performance. 
Qualitatively,  Eigure  5  shows  how  the  estimated  trajectories 
of  the  moving  sensors  (green  solid  line)  behaves  compared 
with  the  estimation  provided  by  the  stationary  sensors 
(black  dashed  line).  The  green  solid  trajectory  is  very  close 
to  the  actual  trajectory  of  the  target  that  we  do  not  plot. 
Note  that  in  all  the  simulations,  the  variance  of  the  process 
noise  is  kept  minimum  of  order  10“^.  It  can  be  observed  in 
the  simulations  that  when  the  variance  of  the  measurement 
is  kept  constant  and  the  variance  of  the  process  noise  is 
varied,  both  performances  of  stationary  and  moving  sensors 
give  very  similar  results. 


Fig.  5.  Qualitative  evolution  of  the  estimated  trajectories  by  moving 
and  stationary  sensors.  Initial  positions  ai'e  (0,  7r/2,  tt,  37r/2)  (left)  and 
(2.1818,  2.4500,  3.7160,  4.5167)  (right)  and  variances  are  in  both  cases 
5  X  10-2. 


V.  Conclusions  and  future  work 

We  have  presented  novel  decentralized  control  laws  for 
the  optimal  positioning  of  sensor  networks  that  track  a 
target.  Euture  research  lines  include  (1)  the  consideration 
of  heterogeneous  collections  of  sensors,  (2)  the  dynamic 
assignment  of  sensors  to  different  targets  and  (3)  investi¬ 
gation  of  decentralized  estimation  and  fusion  schemes. 


Fig.  3.  Evolution  of  absolute  enor  trajectories  with  variances  of  measured 
noise  5  X  10“ ®  (left)  and  5  X  10“ ^  (right). 

Eigure  4,  we  take  as  the  initial  position  for  the  sensors  the 
optimal  position  to  estimate  0.  That  is,  0, 7r/2,  tt  and  3tt/2, 
are  the  initial  positions  for  both  stationary  and  moving 
sensors.  Though  the  set  of  moving  sensors  performs  better, 
the  differences  between  the  estimates  of  the  stationary 
and  moving  sensors  are  comparable  for  variances  of  order 
IQ-"',  10“^  (the  absolute  error  trajectories  overlap)  and 
even  not  so  different  when  the  variances  are  increased 
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=  X!  -  dihi  d2hi  dihj  d2hj) 
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i  3 
n 

=  X!  {d2hi)'^) 
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i  <  j 

n 

—  2  ^  dihi  d2hi  dihj  d2hj 
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i  <  j 

n 
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,3  =  1 
i  <  j 
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Jnr  we  obtain 


[14]  Y.  Bar-Shalom,  X.  R.  Li,  and  T.  Kirubarajan,  Estimation  with 
Applications  to  Tracking  and  Navigation.  New  York,  NY:  John 
Wiley  &  Sons,  2001. 


[15]  D.  Ucihski,  “Optimal  selection  of  measurement  locations  for  param¬ 
eter  estimation  in  distributed  processes,”  Applied  Mathematics  and 
Computer  Science,  vol.  10,  no.  2,  pp.  357-79,  2000. 


[16]  P.  J.  Davis,  Circulant  matrices,  2nd  ed.  Providence,  RI:  American 
Mathematical  Society,  1994. 


[17]  R.  A.  Horn  and  C.  R.  Johnson,  Matrix  Analysis.  Cambridge,  UK: 
Cambridge  University  Press,  1985. 


det  J  = 

n 

Y  dihi  d2hj  dshk^dihi  d2hj  dshkV 

i,j,k=l 

dihk  d2hi  d^hj  +  dihj  d2hk  d^hi  —  dihk  d2hj  d^hi 
—  dihi  d2hk  d^hj  —  dihj  d2hi  d^hfj  . 

Observe  that  this  expression  reduces  to 

n 

det  J  =  Y  dihi  d2hj  d^hk  [(v^  x  v^)  •  v^]  , 

i,j,k—l 


with  Vi  =  {dihi,d2hi,d3hi),  for  i  G  {1,. . .  ,n}. 

We  can  further  simplify  the  determinant  as  follows: 

n 

dihi  d2hj  dshk  [(vi  x  Vj)  •  Vfc]  = 

i,j^k=l 

n 

=  y]  dih^  d2hj  dshk  [(v^  x  v^)  •  v^] 


+  diht  d2hj  d^hk  [(v^  x  v^)  •  v^] 


=  dshk  [dihi  d2hj  -  dihj  d2hi\  (v*  x  vj)  ■  Vk  ■ 

i,  j,  k  =  1 
i  <  j 

The  last  summand  can  be  split  into  two  as 

n  n  n 

E  =E  +E  ^ 

i,  7,  fc  =  1  i,  7,  fc  =  1  i,  7,  fc  =  1 

i  <  j  i  <  j  <  k  i,k  <  j 

now,  rewriting  the  second  of  these  terms  as 

n 

dshk  [dihid2hj  -  dihjd2hi]  (v^  x  v^)  •  = 

i,  j ,  k  =  1 
i,  k  <  j 

n 

y^  dshk  [dihid2hj  -  dihjd2hi]  (v^  x  vj)  ■  Vfc  + 

i,  j ,  k  =  1 
k  <  i  <  j 

n 

y^  dshk  [dihid2hj  -  dihjd2hi]  (v^  x  vj)  ■  Vk  = 

i,  j,  k  =  1 
i  <  k  <  j 

n 

y^  dshi  [dihjd2hk  -  dihkd2hj]  {vj  x  v^)  •  Vi  + 

i,  j,  k  =  1 
i  <  j  <  k 

n 

y^  dshj  [dihid2hk  -  dihkd2hi]  (v^  x  v^)  •  vj  , 

i,  j,  k  =  1 
i  <  j  <  k 

and  using  that  (v^  x  v^)  •  are  invariant  under  cyclic 
permutations  of  i,  j  and  k  G  n},  we  obtain: 


volume  generated  by  the  vectors  v^,  wj  and  Vj.  We 
get  in  this  way  an  analogous  formula  to  that  of  d  =  2. 
As  in  the  two-dimensional  case,  it  is  easy  to  see  that 

det  J=  ^E  ^  Vj)  -Vfcp. 

i,j,k 

B.  Proof  of  Proposition  2.2 

In  first  place,  since  C^  is  differentiable,  (771, . . .  ,?7„)  is 
a  critical  point  of  Cf  if  and  only  if 

d  . 

—  E  8111^77, -pj)  =  0,  Vfc  G  n}. 

i,j€S 

In  other  words,  for  all  fc  G  5  we  have 

0  =  y^sm[2(77fc  -  77i)]  = 
i£S 

sin  2rik  cos  2rii  —  cos  2rik  sin  2rii  = 

iGS  i£S 

cos  277fe,sin277fe,0)  x  (cos  277i,sin277j,0)^  -63. 

iGS 

This  equality  holds  if  (1)  two  vectors  (cos  277^,  sin277fc,  0) 
are  all  aligned,  k  G  S,  and  perpendicular  to  the 
non-zero  vector  x  =  (cos  277*,  sin  277^,  0),  or  (2) 

(cos  277i,sin277i,0)  =  0.  That  is,  (771, . . . ,  77„)  is  a 
critical  point  for  Cf  if  and  only  if 

y^  cos  2?7i  =  0  ,  sin  2r]i  =  0  ,  (8) 

i^S  i^S 

or  any  two  vectors  in  {(cos  277i,sin  277j)}ig5,  are  aligned. 

Secondly,  since  Cf  is  differentiable  and  its  domain  is 
open,  its  global  maxima  are  contained  in  the  set  of  its 
critical  points.  Therefore,  we  will  focus  on  the  valuation 
of  Cf  on  critical  points. 

Let  Qij  denote  =  |77i  —  77^  ].  We  have  that 

y^  sin^(77i  -rjj)  =  y^  sin^  a^j  . 


det  J  = 


y^  {d^hk  [dihi  d2hj  -  dihj  d2hi\ 


i^j^k 


Taking  complex  exponentials,  we  compute 


2E 


sin  aj 


=  2E 

t,jeS 


\ 

J(vj  X  Vj)  ■  Vfc  . 

-El  _2  ) 

GJ6<S  ^  ^ 

Q^O-ij  _  g  IQ'ij 

21 


=  n%  —  y^  cos  2aij  , 
i.jeS 


This  expression  is  equivalent  to: 
det  J  = 

^  E  K'"*  ^  Vj)  •  Vfcp 

i^j^k 

E  l|v*f  livjf  Ikfef  sin^tty  cos2/3y-fc, 

i^j<k 

where  cty  =  and  /3ij^k  =  ffvi  x  Vj,Vfc). 

Here,  |(vj  x  Vj)  •  v^j  has  the  interpretation  of  the 


where  i  =  \/—l.  Using  now  the  formula  for  the  cosine  of 
a  sum,  we  obtain: 

y^  cos2aij  =  y^  cos2{r]i  —  pj)  = 
iJGS  ijeS 

y^  cos  2rii  cos  2rij  -f  sin  2rii  sin  2rij  = 
ijeS 

y^  cos  2r]i  y^  cos  2r]j  -G  y^  sin  2r]i  y^  sin  2r]j  . 
iGS  jGS  i^S  j^S 


Therefore,  at  critical  points  for  which  (8)  holds,  we  have 
that 

2  sin^  aij  =  n| . 
i,jGS 

Consider  now  the  critical  points  (pi, . . . ,  ?7„)  such  that  any 
two  vectors  in  {(cos2r7i,sin2?7i)}jg5  are  aligned.  Let  ni 
be  the  cardinal  of  the  set  Ni  of  vectors  that  coincide  with 
(cos  r/jj ,  sin  )  and  let  n2  be  the  cardinal  of  the  set  N2 
of  vectors  which  are  perpendicular  to  (cos  pij ,  sinp^^ ),  for 
some  ii  G  S.  We  have  that 

2  sin^  Oij  =  2  sin^  +  2  sin^ 
i,jeS  ieNi,jGN2  ieN2,jeNi 

=  2nin2  +  2n2ni  =  4nin2  , 

But  4nin2  <  (rii  +  71.2)^  =  rig,  since  this  is  equivalent  to 
(rii  —  712)^  >  0.  This  allows  us  to  say  that 

Hqo  (pi )  •  ■  •  )  Pn)  —  •Ct(^1  )  ■  •  ■  )  Pn)  ^  ’ 

for  any  critical  point  (pi, . . . ,  ?7„)  of  £t  and  (pi, . . .  ,p„) 
such  that  =  R,  i  G  S. 

To  prove  the  third  fact  of  the  proposition,  consider  xq  = 

♦  27r 

e  "s  .  Since  xq  ^  1,  xq  must  be  a  root  of  p{x)  where 
p{x)  =  a;"“^  H - |-a;  + 1 ,  p{x){x—  1)  =  a;"  —  1 . 


K"  and  the  set  of  n  x  n  circulant  matrices:  given  c  €  K", 
circ(c)  is  the  circulant  matrix  with  first  row  equal  to  c 
and  with  ith  row,  for  i  G  {2,...,n},  equal  to  c  right- 
shifted  {i  —  1)  times.  For  example,  the  last  equation  says 
C  =  circ(ci, . . .  ,c„). 

The  representer  of  an  n  x  71  circulant  matrix  C  = 
circ(ci, . . .  ,c„)  is  the  polynomial  pc{s)  =  ci  +  C2S  + 
•  •  •  +  For  ujn  =  exp(27r-/^/77),  let  G  C”^” 

be  the  Fourier  matrix  of  order  n  given  by 


F*  = 


1 

U)n 

iol 


to" 


1 

,  ,n— 1 
2(«-l) 


,  2(n-l) 


(n-l)(n-l) 

Wn 


Theorem  1.1  ( Diagonalization  of  circulant  matrices): 

If  C  G  is  circulant,  then  its  eigenvalues  are 

Ai  =  pciF>h),  for  7  e  {1, ...  ,77},  and 


C  =  diag(Ai, . . . ,  A„)F„. 


But  this  means 

p(a;o)  =  +  •  •  •  +  e’"^  -1-1  =  0, 


which  is  equivalent  to 


E 


27r 

cos  — (s  —  1)  =  0  , 
ns 


>  sm — (s — 

IsCO 


1)  =  0. 


Therefore,  (771, . . . ,  ?7„)  is  a  critical  point  of  Cf  when  = 
:^{s-  1),  is  G  S,  or  =  ^{s  -  1),  is  G  S.  Because 

of  the  previous  analysis,  we  have  £j{pi, . . .  ,pn)  =  ■ 

Observe  that  since  sin^  a;  =  sin^(— x)  is  periodic  of 
period  T  =  tt,  any  configuration  in 


{{pi+kiTT,...,Pn+  knTr)  |  fci ,  .  .  .  ,  fc„  G  Z} 
for  (771, . . . ,  ?7„)  a  maximum,  will  be  another  maximum. 


C.  Circulant  matrices 


Circulant  matrices  are  an  important  class  of  Toeplitz 
matrices  with  useful  properties  and  are  related  to  the 
Discrete  Fourier  Transform.  For  a  comprehensive  treatment 
of  circulant  matrices  we  refer  to  [16],  see  also  [17]. 

A  matrix  C  G  R.”^"  is  (right)  circulant  if  it  is  of  the 
form 

Cl  C2  *  *  *  Cn 

Cn  Cl  •  •  *  Cn  —  1 

c=  .  .  .  .  • 

C2  C3  •  •  •  Cl 


In  other  words,  a  (right)  circulant  matrix  is  a  matrix 
obtained  by  stacking  cyclically  right-shifted  versions  of  the 
top  row  vector.  There  is  a  linear  isomorphism  circ  between 


